home *** CD-ROM | disk | FTP | other *** search
/ START Magazine / START VOL 4 NO 1.st / POGOSRC.ARC / ARCTAN.C next >
Encoding:
C/C++ Source or Header  |  1985-11-20  |  2.3 KB  |  91 lines
  1.  
  2. /* arctan.c - actually find an angle given an x,y vector.  The angle's
  3.    value will be 0 to 1024.  (1024 = two pi, full circle).  */
  4.  
  5.  
  6. #define WORD int
  7.  
  8. WORD tan_tab[] = {
  9. 1,2,3,5,6,7,8,10,11,12,
  10. 13,15,16,17,18,19,21,22,23,24,
  11. 25,26,28,29,30,31,32,33,34,35,
  12. 36,37,38,39,40,41,42,43,44,45,
  13. 46,47,48,49,49,50,51,52,53,54,
  14. 54,55,56,57,57,58,59,59,60,61,
  15. 62,62,63,63,
  16. 66,70,74,78,81,84,86,89,91,93,
  17. 94,96,97,98,100,101,102,103,104,104,
  18. 105,106,107,107,108,108,109,109,110,110,
  19. 111,111,112,112,112,113,113,113,114,114,
  20. 114,114,115,115,115,115,116,116,116,116,
  21. 116,117,117,117,117,117,117,118,118,118,
  22. 118,118,118,118,
  23. 118,120,121,122,123,123,124,124,124,124,
  24. 125,125,125,125,125,125,126,126,126,126,
  25. 126,126,126,126,126,126,126,126,126,126,
  26. 126,126,126,126,126,126,126,127,127,127,
  27. 127,127,127,127,127,127,127,127,127,127,
  28. 127,127,127,127,127,127,127,127,127,127,
  29. 127,127,127,127,128,128} ;
  30.  
  31.  
  32. WORD small_arctan(y,x) /* Pass y,x, and an angle between 0 and 512 will be returned*/
  33. long y,x; /* */
  34. {
  35.    register int index; /* calculated offset into arctan table */
  36.    register int r;     /* temperary variable */
  37.    register int x_neg,y_neg; /* sign flags */
  38.  
  39.    x_neg = y_neg = 0;
  40.  
  41.    if (y == 0)
  42.       {
  43.       if (x < 0)
  44.     return(256);
  45.       else
  46.     return(0);
  47.       }
  48.    if (x == 0) /* no divide by zeros */
  49.       {
  50.       if (y < 0)
  51.     return(512-128);
  52.       else
  53.     return(128);
  54.       } 
  55.    if (x<0) { /* make x and y positive, but set flags to remember */
  56.       x_neg = 1;
  57.       x = -x;
  58.    }
  59.    if (y<0) {
  60.       y_neg = 1;
  61.       y = -y;
  62.    }
  63.   if (y <= x)
  64.       index = (y<<6)/x; /* table is divided into three parts, so figure */
  65.    else if (y/x < 9)    /* which part to use */
  66.       index = 56 + ((((y<<4)/x)-1)>>1);
  67.    else if ((r = (y/x)) <= 135)
  68.       index = 128+((r-9)>>1);
  69.    else 
  70.       index = 192; /* point index to max value */
  71.  
  72.    r = tan_tab[index]; /* get theta from lookup table */
  73.  
  74.    if (!x_neg && !y_neg) /* the table only has the first quadrant, so use */
  75.       return(r);         /* semetries to get the other quadrants */
  76.    if (x_neg && !y_neg)
  77.       return(256 - r);
  78.    if (x_neg && y_neg)
  79.       return(256 + r);
  80.    return((512 - r));
  81. } /* end arctan */
  82.  
  83.  
  84. WORD 
  85. arctan(x,y)
  86. int x,y;
  87. {
  88. return (rscale_by(small_arctan( (long)y, (long)x),360,512));
  89. }
  90.  
  91.